Natural Landmark-Based Autonomous Navigation using Curvature Scale Space

This paper describes a terrain-aided navigation system that employs points of maximum curvature extracted from laser scan data as primary landmarks. A scale space method is used to extract points of maximum curvature from laser range scans of unmodified outdoor environments. This information is then fused with odometric information to provide localization information for an outdoor vehicle. The method described is invariant to the size and orientation of the range images under consideration (with respect to rotation and translation), is robust to noise, and can reliably detect and localize naturally occurring landmarks in the operating environment. The algorithm is demonstrated in the application of a road vehicle in an unmodified operating domain. Keywords— landmark extraction, extended Kalman filter, scale space, outdoor localization.